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(54) Electronnagnettc position single axis systenn 

(57) A system (20) for determining the position of a 
medical device (22) having a sensor (26) comprises a 
plurality of field radiators (56,58,60) wherein each field 
radiator has a plurality of radiator elements 
(32,34,36,38,40,42). Each radiator element generates 
a magnetic f ield such that each magnetic field is distinct 
from one another due to the use of a different frequency. 
The magnetic fields are measured by the sensor (26). 
The field radiators (56,58,60) and the sensor (26) are 
connected to a signal processor (25). The signal proc- 
essor (25) includes an initial position estimator for es- 
tablishing an initial position estimate for the sensor; a 



magnetic field calculator for calculating the magnetic 
field at the initial position estimate; a steepest descent 
calculator for calculating a steepest descent of the cal- 
culated magnetic field to the measured magnetic field; 
and a new position estimate calculator for calculating a 
new position estimate of said sensor (26) based on said 
steepest descent. The signal processor (25) determines 
the position of the sensor (26) when the new position 
estimate of the sensor Is within the desired range of ac- 
curacy for the system. Alternative field radiator arrange- 
ments are also provided In conjunction with a novel al- 
gorithm utilizing a global convergent technique. 
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Description 

FIELD OF THE INVENTION 

5 [0001] The present invention relates generally to object tracking systems, and specifically to non-contact, electro- 
magnetic medical systems and methods for tracking the position and orientation of an object. The present invention 
is also directed to a novel calibration method for electromagnetic-based medical tracking systems that can account for 
the effects of interference from nonmoving metallic objects. 

10 BACKGROUND OF THE INVENTION 

[0002] Non-contact methods of determining the position of an object based on generating a magnetb field and meas- 
uring its strength at the object are well known in the art. For example. U.S. patent 5,391 ,1 99, and PCT patent application 
publication WO 96/05768. which are incorporated herein by reference, describe such systems for detennining the 
15 coordinates of a medical probe or catheter inside the body. These systems typically include one or more coils within 
the probe, generally adjacent to the distal end thereof, connected by wires to signal processing circuitry coupled to the 
proximal end of the probe. 

[0003] U.S. patent 4,710,708, which is incorporated herein by reference, describes a location determining system 
using a single axis solenoid with a ferromagnetic core as a radiating coil. There are a plurality of magnetic coil receivers. 

20 The position of the solenoid is determined assuming that it radiates as a dipole. 

[0004] PCT patent application publication WO 94/04938, which is incorporated herein by reference, describes a 
position-finding system using a single sensing coil and an array of three, three-coil radiators. The radiator coils are 
wound on non-ferromagnetic forms. The position of the sensing coil is detemnined based on a dipole approximation to 
the magnetic fields of the coils where an estimate of the orientation of the sensor coil is first utilized in order to determine 

25 the position of the sensor coil in that order. Additionally, the radiator coils of each array are energized sequentially 
using a time multiplexing approach. Interestingly, although this reference discloses that frequency multiplexing can be 
utilized in order to significantly increase the operating speed of the position system, it clearly indicates that there are 
disadvantages to this type of approach due to its complexity. It is also important to note that although this reference 
teaches a single axis sensor position and orientation tracking system, it does not address any specific method for 

30 calibrating the system. 

[0005] Accordingly, to date, there is no known system or method that provides for a electromagnetic position sensor 
single axis system and method that is capable of being simultaneously driven through frequency multiplexing utilizing 
a novel exact solution technique and a novel calibration method. 

35 SUMMARY OF THE INVENTION 

[0006] The present invention is a novel system and method used for detennining the position and orientation of a 
medical device having a single sensor an-anged along the longitudinal axis of the device. The system comprises a 
plurality of field radiators wherein each field radiator has a plurality of radiator elements. Each radiator element gen- 

40 erates a magnetic field that is distinct from the others through its frequency which Is sometimes referred to as "frequency 
multiplexing". A signal processor is operatively connected to the field radiators and the sensor of the medical device 
for receiving a sensing signal from the sensor indteative of the magnetic field sensed at the sensor. The sensing signal 
defines a measured magnetic field at the sensor. The signal pr<x:essor also has a desired range of accuracy for the 
system which is stored therein. The signal processor Includes an initial position estimator for establishing an initial 

45 position estimate for the sensor (which is based on the dipole approximation); a magnetic field calculator for calculating 
the magnetic field at the initial position estimate; a steepest descent calculator for calculating a steepest descent of 
the calculated magnetic field to the measured magnetic field; and a new position estimate calculator for calculating a 
new position estimate of the sensor based on the steepest descent. The magnetic field estimator and the steepest 
descent calculator use the exact theoretical field expressions and pre-stored calibration data which are unique to the 

so system. The signal processor detemnines the position of the sensor when the new position estimate of the sensor is 
within the desired range of accuracy for the system. 

[0007] The system also includes pro-stored calibration infonmation for use with the magnetic field calculator and the 
steepest descent calculator for calculation of the magnetc field and the steepest descent step respectively. This cali- 
bration data is uniquely derived for each system using a novel calibration system and method along with Its unique 
55 algorithm. The system also has a predetemnined and stored desired range of accuracy of < 0.1 cm (the accuracy of 
the system). However, the incremental steps (iterations) for the algorithm are stopped as soon as the change from a 
previous step is less than 0.001 cm which is necessary in order to get better than 1 mm accuracy for the system. 
[0008] One embodiment for the plurality of field radiators are arranged in a fixed arrangement and are contained in 
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a fixed plane on a location pad. Other field radiator embodiments as described later do not necessarily have to lie in 
the same plane. In the first embodiment, the radiator elements of the field radiators are mutually orthogonal. In this 
embodiment, the system has three fixed radiators wherein each radiator has three generator elements or coils mutually 
orthogonal to each other. 

5 [0009] Additionally, the signal processor determines both the position and orientation of the sensor such that the 
position of the sensor is derived in three different directions (X, Y. Z) and at least two orientations (pitch and yaw) which 
is generally known as 5 degrees of freedom (DOF). However, the restriction to 5 DOF is due to the coil sensor symmetry 
as shown. Thus, it is contemplated by the present invention to also provide for 6 DOF (X, Y, Z directions and three 
orientations roll, pitch and yaw) by changing the configuration of the sensor coil to an asymmetrical shape. 

10 [0010] The system further comprises a display operatively connected to the signal processor for displaying the po- 
sition and orientation of the sensor. Moreover, the display displays the position and the orientation of the sensor with 
respect to an anatomical feature of a patient. This is particularly useful for navigating a surgical instrunnent within a 
patient's anatomy for performing a surgical procedure. The system further utilizes a reference device, which can be 
an external removable patch, for establishing a frame of reference. One particular use of the system is to map the 

15 heart thereby creating a 3D model of the heart. The sensor can be used together with a physiological sensor, such as 
an electrode in order to map a physiological condition, for instance, a local activation time (LAT). 
[0011] The present Invention also Includes a novel method of detemnining the position and orientation of a sensor 
relative to a plurality of field radiators of known location wherein each of the field radiators comprises a plurality of co- 
located radiator elements. Each radiator element produces a differenliable field from all other field generating elements 

20 through frequency multiplexing. The sensor produces sensing signals indicative of the magnetic field at the sensor and 
from which the field at said sensor may be calculated. The method comprises the steps of; 

(a) establishing a desired range of accuracy; 

(b) determining an initial estimate of sensor position and orientation; 

25 (c) calculating the magnetic field at the estimated sensor position and orientation; 

(d) calculating the steepest descent from the calculated magnetic field at the estimated sensor position and ori- 
entation to the measured field at the sensor; 

(e) calculating a new estimate for said sensor position and orientation from the steepest descent; 

(f) iterating steps (c) - (e) based on the newly calculated sensor position and orientation estimate of step (e) to 
30 refine the sensor position and orientation estimate. 

[001 2] As mentioned above, the desired range of accuracy for the single axis sensor position and orientation system 
is ^ 0.1 cm (the accuracy of the system). However, the incremental steps of the position and orientation algorithm are 
stopped as soon as the change from a previous step is less than 0.001 cm which Is necessary in order to get better 

35 than 1 mm accuracy for the system. Additionally, the method Includes establishing , storing and using of calibration 
information for the field radiators. This calibration information is derived using a novel calibration system and method. 
The calibration information is used at steps (c) and (d) for calculating a new estimate for the sensor position and 
orientation in order to provide greater accuracy to the system. The method also includes an optional step of refining 
the initial starting point of the sensor position and orientation using a dipole approximation in step (b). 

40 [0013] The method further includes determining the position of the sensor in three different directions (X,Y,Z) and 
the orientation of the sensor in at least two orientations (pitch and yaw). Additionally, a display is used with this method 
for displaying the position and orientation of the sensor to include mapping this information to a displayed an anatomical 
feature of a patient which can be in the f onm of a pre-acquired image, real time image or model of the anatomy of interest. 
[0014] The present invention also includes a novel calibration method which accounts for the effects of stationary 

45 metallic objects that are located within the mapping volume when the position and orientation medical system is in use. 
The novel calibration method Is used for any medical system capable of generating a magnette field for tracking a 
position of a medical device. The method comprising the steps of: 

(a) defining a mapping volume within the generated magnetic field; 
so (b) placing a metallic object within the mapping volume; 

(c) aligning a sensor at a first point within the mapping volume and measuring the magnetic field at the first point 

with the sensor to establish a first coordinate position (Xj, Yj, Zj); 

(d) moving the sensor to a next point (Xj + dx, Yj + dy, Zj + dz) along one coordinate axis by an added distance 
component (dx, dy, dz) and measuring the magnetic field at the next point to establish a next coordinate position; 

55 (e) interpolating the magnetic field at an intennediate point between the first position and the next coordinate 

position to establish an interpolated intermediate coordinate position; 

(f) determining the position difference between the interpolated intermediate coordinate position and an actual 
intermediate coordinate position; 
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(g) comparing the position difference to an error limit; 

(h) setting {X,. Yj. Z^) of the next point as (X| = Xj + dx. Yj = Yj + dy. Zj = Z| + dz) if the position difference is within 
the error limit and repeating steps (d) - (g) along another coordinate axis; and 

(i) setting the added distance component (dx, dy. dz) by decreasing the value of the added distance component if 
5 the position difference is not within the error limit and repeating steps (d) - (g) along the same coordinate axis. 

[0015] The method also includes completing the calibration method for the entire mapping volume in accordance 
with the steps outlined above. Although, the error limit can be any reasonable error range, it is preferable that the error 
limit be < 1 mm for the greatest accuracy effects. Additionally, the sensor is stepped or moved a distance ranging from 
10 about 2 cm to about 3 cm. Moreover, with respect to the stepping of the sensor, the distance moved should remain 
constant to eliminate variability in the calibration. Also, step (i) is accomplished by decreasing the value of the added 
distance component through division by a factor of two (Xj + dx/2, Yj + dy/2, Z^ + dz/2) 

[001 6] A second embodiment of the calibration method accounting for static metallic objects comprises the steps of: 

15 (a) defining a mapping volume within the generated magnetic field; 

(b) placing a metallic object within the mapping volume; 

(c) aligning a sensor at a first point within the mapping volume and measuring the magnetic field at the first point 

with the sensor to establish a first coordinate position (Xj, Yj, Z-), 

(d) extrapolating the magnetic field of a next point (Xj + dx, Yj + dy. Zj + dz) along one coordinate axis by an added 
20 distance component (dx, dy, dz); 

(e) calculating the coordinate position at the extrapolated next point based on the extrapolated magnetic field to 
establish an extrapolated coordinate position; 

(f) determining the position difference between the extrapolated coordinate position and the actual coordinate 
position of the next point; 

25 (g) comparing the position difference to an error limit; 

(h) setting the added distance component (dx, dy, dz) according to a predetemilned distance if the position differ- 
ence is within the en'or limit, aligning the sensor to a new point within the mapping volume along another coordinate 
axis and measuring the magnetic field at the new point with the sensor to establish a new point coordinate position 
and repeating steps (d) - (g) along the other coordinate axis; and 

30 (i) setting the added distance component (dx, dy, dz) by decreasing the value of the added distance component if 
the position difference is not within the error limit and establishing an Intemriediate point by repeating steps (d) - 

(g) along the same coordinate axis. 

[0017] The predetemilned distance may remain constant and is preferably approximately 3 cm. However, the pre- 
ss detemiined distance or step distance can be varied by the user as well. Additionally, the added distance component 
can be decreased by a factor of two such that the intermediate point or position is defined as (X, + dx/2, Yj + dy/2, Zj 
+ dz/2). 

[0018] For either calibration embodiment accounting forthe effects of stationary metallic objects, the sensor is moved 
according to the vertices of a cube and the entire mapping volume comprises a plurality of cubes. Each cube is defined 
40 by measurements derived from at least four different vertices. Generally, the calibration method is accomplished for a 
mapping volume Is approximately 20 cm X 20 cm X 20 cm or (20 cm)3. For controlled accuracy in the calibration, the 
sensor is moved by the ami of a robot. 

[001 9] These and other objects, features and advantages of the present invention will be more readily apparent from 
the detailed description set forth below, taken in conjunction with the accompanying drawings. 

45 

BRIEF DESCRIPTION OF THE DRAWINGS 
[0020] 

50 Fig. 1 is a perspective view of one embodiment of a position sensing system in accordance with the present 

invention; 

Fig. 2 Is a schematic Illustration of the position sensing components of Fig. 1 ; 

Fig. 3 is a schematic flow chart showing a method used to find position and orientation coordinates in accordance 
with a preferred embodiment of the present invention; 
55 Figs. 4A - 4F are graphic Illustrations of the method of Fig. 3; 

Fig. 5 is a schematic illustration of a calibration system according to the present invention; 
Fig. 6 is a schematic flow chart showing a method of the calibration system of Fig. 5; 

Fig. 7 Is a schematic illustration of an alternative embodiment for a radiator arrangement according to the present 
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invention having radiator coils that are not co-located but are mutually orthogonal to each other: 
Fig. 8 is a schennatic illustration of another alternative embodiment for a radiator arrangement according to the 
present Invention having radiator coils that are not co-located and are not mutually orthogonal to each other; 
Fig. 9 is a schematic illustration of another alternative embodiment for a radiator arrangement according to the 
5 present invention having radiator coils that are co-located and but are not mutually orthogonal to each other; 

Fig. 10 is a schematic flow chart showing a method used to find position and orientation coordinates with the 
radiator arrangements of Figs. 7 - 9 in accordance with another preferred embodiment of the present invention; 
Fig. 11 is a schematic illustration of a calibration cube utilized in a novel calibration method for the calibration 
system of Fig. 5; 

10 Fig. 12 is a schematic flow chart illustrating one embodiment of a novel calibration method for accounting for the 

effects of nonmoving metallic objects utilizing the calibration system of Fig. 5; and 

Fig. 13 is a schematic flow chart illustrating a second embodiment of a novel calibration method for accounting for 
the effects of nonmoving metallic objects utilizing the calibration system of Fig. 5. 

15 DESCRIPTION OF THE PREFERRED EMBODIMENTS 

[0021] The present Invention is a novel medical tracking system and method for determining the position and orien- 
tation of an object, such as a probe or catheter, utilizing a single axis position sensor and a novel position and orientation 
determination method. The system is also utilized with a novel calibration system and method. 

20 [0022] One embodiment of a novel position and orientation system 20 according to present invention is shown in 
Fig. 1 . The system 20 comprises a console 21 , which enables the user to observe and regulate the functions of a 
peripheral medical device such as a probe or catheter 22. The catheter 22 is connected to the console 21 at a signal 
processor 25 (computer) by wire 28. The catheter 22 has a single position sensor 26 fixed near the distal end of the 
catheter 22 along the longitudinal axis of the catheter 22 wherein the position sensor 26 is opcrativcly connected to 

25 the signal processor 25 by wire 28. Console 21 preferably includes that the signal processor (computer) 25 contains 
signal processing circuits which are typically self-contained inside the computer 25. A display 27 and keyboard 29 are 
operatively connected to the signal processor 25 wherein keyboard 29 is connected by wire 29a. The display 27 permits 
real-time display of the position and orientation of the catheter 22 at the position sensor 26. Display 27 is particularty 
useful for displaying position and orientation images and information of the position sensor 26 along with an image or 

30 model of particular anatomy such as an organ. One particular use of the system 20 is to map a heart thereby creating 
a 3D anatomical map of the heart. The position sensor 26 is used together with a physlologcal sensor, such as an 
electrode for mapping a physiological condition, e.g. LAT. 

[0023] The signal processor 25 typically receives, amplifies, filters and digitizes signals from catheter 22, including 
signals generated by position sensor 26 whereupon these digitized signals are received and used by the signal proc- 

35 essor 25 to compute the position and orientation of the catheter 22 at the position sensor 26. 

[0024] The system 20 may also include a reference device 30, which also utilizes a position sensor (not shown), for 
establishing a frame of reference for the system 20. The reference device 30 is an external patch removably adherable 
to the exterior surface of a patient and is operatively connected to the signal processor 25 by wire 31 . It is important 
to note that the reference device may consist of other alternative forms such as a second catheter or probe with position 

40 sensor for internal placement within a patient. 

[0025] Reference is now made to Fig. 2. which schematically illustrates the components of the position sensing 
system 20 responsible for determining the position and orientation of the catheter 22 at the position sensor 26. As 
shown, the position sensor 26 is in the fonn of a coll or hollow cylinder. However, other fomris for the position sensor 
26, such as barrel-shaped, elliptical-shaped, (to include asymmetrical shapes), etc., are also contemplated herein. It 

45 is also contemplated by the present invention that the sensor coil 26 can optionally include a flux concentrator as a 
core. Additionally, the sensor 26 may be in other fomns rather than a coil, for instance, a magnetoreslsth/e (MR) sensor, 
or a riux gate or hall effect sensor. 

[0026] As illustrated and mentioned above, the position sensor 26 is in the form of a sensing coil and is positioned 
near the distal end of the catheter 22 such that the sensor coil 26 is preferably coaxial or along the longitudinal axis of 

50 the catheter 22. As defined herein the position sensor 26 can be optionally referred to as a position sensor, location 
sensor, position and orientation sensor, sensor coil, sensing coil, coil or like terminology. Preferably, catheter 22 has 
a lumen 24 which extends the length of catheter 22. Preferably, sensor coil 26 has a hollow core and is positioned 
within catheter 22 such that the axis of sensor coll 26 lies within lumen 24 and along or parallel to the axis of catheter 
22. This constmction provides access from the proximal end of the catheter 22 to its distal end through the hollow core 

55 of sensor coil 26, pemnitting the catheter 22 to be used as a delivery device for the delivery of any type of therapeutic 
through the sensor coll 26. Sensor coil 26 and lumen 24 permit the catheter 22 to be used as a delivery device for the 
delivery of any type of therapeutic or diagnostic agent or modality or implantable device. For instance, therapeutics, 
such as pharmaceutical or biological agents, factors, proteins and cells; tissue repair or treatment polymers such as 
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glues and adhesives; energy modalities , such as optical waveguides for delivery of laser energy, ultrasonic waveguides 
for the delivery of therapeutic ultrasound, microwave antennas and radio frequency (RF) conductors are just some of 
the examples of therapeutics contemplated for delivery through the catheter 22 due to its unique arrangement of the 
sensor coll 26 and lumen 24. Likewise, examples of suitable diagnostics for delivery through the catheter 22. include. 
5 but are not limited to: contrast agents dyes, marking fluids or substances. Moreover, implantable devices such as 
miniature electronics, implantable sensors including biological diagnostic chips, pacing devices, prosthetics, etc. are 
also suitable with this arrangement. 

[0027] System 20 further comprises radiator elements or coils 32, 34, 36, 38, 40, 42, 44, 46, and 48 (also known as 
generator coils). In one embodiment, the coils are wound in sets of three orthogonal and concentric coils forming 

10 radiators 56, 58, and 60. respectively. Preferably, the coils 32. 34, 36, 38. 40, 42, 44, 46, and 48 are each wound around 
a support member such as a spool. In this first embodiment, each radiator 56, 58 and 60 has three coils that are co- 
located. Accordingly, the coils of each radiator are concentric with each other and mutually orthogonal with each other. 
The concentric arrangement is accomplished by having each coil within a particular radiator shaped such that the colls 
with their respective support member each have a different diameter For instance, by way of example with respect to 

15 radiator 56, coil 36 accommodates and receives coils 32 and 34 and coil 34 accommodates and receives coil 32. Thus, 
coil 36 (with its support member) has a diameter that is greater than the diameter of coil 34 (with Its support member) 
wherein the diameter of coil 34 is greater than the diameter of coil 32 (with its support member). Likewise, this type of 
concentric arrangement is applied to ail of the radiators 56, 58 and 60. 

[0028] in this first embodiment, the radiators 56, 58 and 60 are fixedly mounted to define a plane or location pad 61 . 
20 The radiators 56, 58 and 60 may be placed in any desired fixed arrangement such as an arrangement in the form of 
respective vertices of a substantially equilateral triangle having sides up to 1 meter in length. The radiator coils 32, 34, 
36, 38, 40, 42, 44, 46 and 48 are connected by wires 62 to a radiator drive 64. 

[0029] Generally, radiator drive 64 simultaneously energizes each of radiator coils 32, 34, 36, 38, 40, 42, 44, 46 and 
48 through frequency multiplexing. Each of these coils generates a respective magnetic field (quasi-stationary field), 

25 which induces a voltage in sensing coil 26 which is used as a sensing signal. Accordingly, since each radiator coil 32, 
34, 38, 38, 40, 42, 44, 46 and 48 generates a different magnetic field, the sensing signal that Is generated at the sensing 
coil 26 is comprised of contributions from each of the radiator coils 32, 34, 36, 38, 40, 42, 44, 46 and 48. The sensing 
signal is then fed back to processor 25. The processor 25 then calculates the three position (x, y, z direction) and two 
orientation coordinates (pitch and yaw) (five degrees of freedom or 5 DOF) of the sensor coil 26 from the nine values 

30 of sensing signals. The method of calculation is described in detail later below. For instances where the sensing coil 
26 has an asymmetrical shape. 6 DOF are calculated to include the roll orientation. 

[0030] Additionally there are other alternative radiator arrangement embodiments that are particularly useful with 
the present invention. As shown in Fig. 7, a second radiator arrangement includes radiators 56a, 58a and 60a having 
radiator coils 32, 34, 36, 38, 40, 42, 44, 46 and 48 respectively (same coils as mentioned above). The radiator coils 

35 32, 34, 36, 38, 40, 42, 44, 46 and 48 are mutually orthogonal to each other within their respective radiator 56a, 58a 
and 60a. However, these radiator coils are not concentric and are not co-located. But rather, the radiators 56a, 58a 
and 60a comprise a spaced or nonco-located "triplet group" in which the distance between the coils of each nonco- 
located triplet grouping is no more than three to four times the size of the radiator coil diameter. 
[0031] A third radiator an-angement embodiment is shown in Fig. 8. In this embodiment, radiators 56b, 58b and 60b 

40 have radiator coils 32, 34, 36, 38. 40, 42, 44, 46 and 48 respectively that are not co-located, not concentric and are 
not mutually orthogonal to each other. The orientation of each coil is arbitrary with the only limitation being that one 
coil is not parallel to another coil of the same triplet grouping 56b, 58b and 60b. 

[0032] Fig. 9 illustrates a fourth embodiment of a radiator arrangement in accordance with the present invention. In 
this embodiment, radiators 56c, 58c and 60c comprise a co-located arrangement for the radiator coils 32, 34, 36, 38, 
45 40, 42, 44, 46 and 48 respectively wherein the colls of each radiator are concentric with respect to each other similar 
to the radiator embodiment of Fig. 2. However, the coils of each radiator 56c, 58c and 60c are are not orthogonal to 
each other. Again, the only limitation to the coil orienlalions is that one coil is not parallel to another coil in a particular 
radiator an'angement 56c, 58c and 60c. 

50 Position and Orientation Method 

[0033] Fig. 3 is a schematic flow chart illustrating a method and associated algorithmic components for determining 
the coordinates of sensing coil 26, in accordance with a prefen^ed embodiment of the present invention. The general 
method steps will be described below and the specific steps of the novel algorithm will be described in detail later in 
55 this disclosure. Signal processor 25 (Figs. 1 and 2) determines three positions (X, Y, and Z) and two orientation (pitch 
and yaw) coordinates of sensing coil 26 by the method described herein. Prior to beginning any medical procedure, 
the system 20, through the signal processor 25, has been pre-programmed with a desired degree of accuracy achieved 
through calibration. This is a desired accuracy range which Is usually 5 0.1 cm (the accuracy of the system). However, 
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the Incremental steps or iterations of the algorithm are stopped as soon as the change from a previous step is less 
than 0.001 cm. The last is necessary in order to get 1 mm accuracy). Additionally, for each system 20 that is manu- 
factured, the generators 56, 58 and 60 through their generator coils 32. 34. 36, 38, 40. 42, 44, 46 and 48 respectively 
are uniquely calibrated by a novel calibration system and method which is described In greater detail later in this 
5 disclosure. 

[0034] The system 20, such as the embodiment illustrated in Fig. 1 , is located in a clinical setting, such as a surgical 
suite: and the locator pad 61 is positioned in a desired location. One preferred location is to position the locator pad 
61 near the patient, for instance, beneath a non-metallic operating table (not shown). The system 20 is activated and 
the generator coils 32, 34, 36, 38, 40, 42, 44, 46 and 48 of the radiators 56. 58 and 60 are simultaneously energized 

10 wherein each coil radiates distinct electromagnetic fields, each having a distinct frequency. Accordingly, nine separate 
magnetic (quasi-stationary) fields are created. Due to the pre-fixed an-angement of the location pad 61 , a predictable 
magnetic field volume (operating volume) covering approximately a 20 cm X 20 cm X 20 cm or (20 cm)3 volume (based 
on the radiators 56, 58, and 60 being configured in location pad 61 In a triangular arrangement having sides of 40 cm 
X 40 cm X 37 cm) is projected at the patient which more than covers the areas desired for Insertion and tracking of 

15 the catheter 22 . It is important to note that these dimensions are just one of the illustrated examples of size contemplated 
by the present invention. Smaller and larger volumes are clearly contemplated by the present invention. 
[0035] The catheter 22 Is then placed In the patient and brought into the operating volume and the sensor coll 26 
produces sensor signals indicative of the magnitude of the magnetic field at the sensor coll 26. These sensor signals 
are provided to the processor 25 through wire 28 wherein the magnitude of the magnetic field (measured field) is 

20 detenmlned and stored in the processor 25. 

[0036] As best shown in Fig. 3, at this point the signal processor 25 uses an artsltrary starting point (reflecting both 
position and orientation) and preferably utilizes a dipole approximation (an optional step) for one iteration In order to 
get from this arbitrary point to a starting position for the steepest descent. The arbitrary point is a pre-programmed 
starting point In the processor 25, for instance, usually a point chosen at the center of the mapping volume. Then, the 

25 program in the signal processor 25 moves directly Into the calculation with no approximations. However, the conver- 
gence can be expedited (calculation time shortened) by using the dipole approximation as a first step thus bringing 
the solution closer to the actual position. From there, the full magnetic field with no approximations Is utilized. Thus, 
the arbitrary starting point is used for the dipole approximation as well. 

[0037] Once the initial position and orientation estimate is made with the dipole approximator 72, the processor 25 
30 calculates the magnetic field at the estimated position and orientation using a magnetic field calculator 74. After this 
calculation, the steepest descent from the calculated magnetic field of the estimated sensor position and orientation 
to the measured magnetic field of the sensor coil 26 is calculated using a steepest descent calculator 76 which employs 
the Jacobian technique. It is important to note that the Jacobian is calculated for all nine radiator coils 32, 34, 36, 38, 
40, 42, 44, 46 and 48 respectively by the steepest descent calculator 76. The magnetic field estimator 74 and the 
35 steepest descent calculator 76 use exact theoretical magnetic field expressions as well as pre-stored calibration data. 
[0038] Based on this calculation, a resulting computation is made, which actually reflects a change (AX), indicating 
the steepest change in value between the new estimated position and orientation and the previous position and ori- 
entation (the actual position and orientation Is not known until the end of the calculation). This result, Ax, is added to 
the previous estimate of the sensor position and orientation to arrive at a new estimate of sensor position and orientation . 
40 Additionally, calibration Infonnatlon that has been pre-stored In the signal processor 25 In accordance with a novel 
calibration system and method of the present invention is also utilized (greater detail provided below). Accordingly, a 
pre-detemnined calibration factor is used to adjust the Jacobian and the fields. 

[0039] At this point, the new estimate of the position and orientation of the sensor coil 26 is compared to the prede- 
termined desired accuracy range. If the new estimate of the position and orientation of the sensor coil 26 is not within 
45 this range, then the steps are repeated beginning with calculating the magnetic field at the new estimated position and 
orientation. 

[0040] Additionally, for the alternative radiator arrangement embodiments illuslraled in Figs. 7-9, a global convergent 
technique is applied by a global converger 77 (Fig. 10) in order to arrive at a new estimate of position and orientation 
that is within the predetemiined accuracy range. The specific algorithm Is discussed in detail later below. 

50 

Position and Orientation Algorithm 

[0041] In order to better understand the above-described method, the novel algorithm utilized by this method will 
now be specifcally addressed according to each method step. For illustration purposes, the location and orientation 
55 of the sensor coil 26 is best described with respect to Figs. 4A - 4C. As shown in Fig. 4A, the center of the sensor coil 
26 is positioned at point P. The axis of the sensor coil 26. which defines its orientation, is shown as dashed line A in 
Fig. 4A. 

[0042] The position and orientation of the sensor x may be defined as follows: 
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40 



45 



; = {f,ii) (1) 



5 whereinTequals the x, y and ^coordinates of the position vector OP as shown in Fig. 4B, The vectorn, a measure 

of the sensor orientation, corresponds to the x, yand zcoordinates, n^, and n^, respectively, ol A* (see Fig. 4C), an 
orientation vector which is a parallel translation to the origin of sensor axis orientation vector A. 
[0043] A partial schematic drawing of the system 20 of the invention is depicted in Fig. 4D in which Q^, Q2 and Q3 
are the three radiators 56, 58 and 60 respectively. Each of these radiators 56, 58 and 60 comprises three colls (32, 

10 34, 36, 38, 40. 42, 44, 46 and 48 respectively). For ease of illustration, radiator 0^ comprises radiator coils one, two 
and three (32, 34 and 36); radiator Q2 comprises coils four, five and six (38, 40 and 42); and radiator Q3 comprises 
coils seven, eight and nine (44. 46 and 48). 

[0044] With this arrangement, through the sensor coil 26, measurements of the fields at the sensor coil 26 due to 
each radiator coil 32, 34, 36, 38, 40, 42, 44, 46 and 48 is provided to the processor 25 for use with detailed steps below. 
15 [0045] Step (a): Determine the initial estimate of sensor position and orientation using the initial position and orien- 
tation estimator 70. 

[0046] For the Initial estimate of sensor position and orientation, we assume an ariaitrary position of the sensor coil 
26 as follows: 



[0047] For convenience, Xq may be arbitrarily chosen so as to be approximately in the center of the system location 
25 volume. For example, the three radiators and Q3 may be viewed as being placed at the vertices of a triangle 

(Fig. 4E). The sides of the triangle may be bisected by medians M^, and M3. The initial estimate of the three- 
dimensional sensor position Tq may be chosen to be at the intersection of the medians of the radiators, at a distance, 
20 cm for example, above the plane formed by the radiators. Likewise, for convenience, may be chosen to be a 
positive unit vector parallel to the z axis. 
30 [0048] Optional Step (b): Refinement of the estimated sensor position and orientation based on the dipole approxi- 
mation using the dipole approximator 72. 

[0049] The initial estimate of the sensor position and orientation may be refined using the dipole approximator 72 
based on the dipole approximation, as described below: 

[0050] As shown in Fig. 4D, we may define the vectors ^2 ^3 position vectors from the origin to the 
35 radiator centers for radiators Q^, Qg and Q3, respectively. S defines the coordinate of the sensor coil 26. For each of 
the radiators, we may define a relationship aj {/ = 1 to 3) as follows: Pj = - where X 0 's an Initial position: 





3, 























(3) 



(4) 



50 [0051] We may define ffior / - 1 to 9 as the measured field values at the sensor S of the fields attributed to colls 
numbers one (1) through nine (9). The magnetic field values for each coil are measured according to the known tech- 
niques as outlined in commonly assigned PCT patent application publication WO 96/05768 which is incoTDorated herein 
by reference. 

[0052] We may also define my for y = 1 to 3 as the sum of the squares of the measured fields at the sensor due to 
55 the coils comprising each of the radiators. Thus, for the system shown in Fig. 2 and Fig. 4D. we have three equations 
in m as follows: 
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and 
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[0053] A sensor at points far removed from the radiator coils (distance from point to the radiator > radiator coil radius) 
will experience magnetic fields that are said to be dipolar in character (see for example J. D. Jackson in Classical 
Electrodynamics, second edition, John Wiley & Sons, New York, 1975, page 178, which is Incorporated herein by 
15 reference). Under these conditions, as shown in U.S. Patent 5,913,820 which is incorporated herein in Its entirety by 
reference, for the case of three radiators Q^, Q2 and Q3, each radiator composed of three concentric and orthogonal 
radiator coils, the distance from the sensor to each of the radiators may be approximated in terms of the above-defined 
and calculated values of a and m by the following equations: 



20 



25 



30 



^2^ 



35 



40 



45 



SO 



55 



Wherein r^, and are the distances from the sensor to the center of radiators , Q2 and Q3, respectively. We may 
use the three distances r,, r2 and r^Xo triangulate to an approximate sensor locationT{x,y,z). Each of the three distances 
r^, and may be thought of as radii of spheres about each of the radiators. The triangulation process solves for the 
point of intersection of these three spheres, which results In an approximate sensor location as described by7(x,y,z) 
(see Figs. 4B and 4F). 

[0054] Knowing the characteristics of each of the radiator coils (number of windings, coil diameter, etc.) and the 
current passing through these coils, we may calculate /5(7), a [9, 3] matrix describing the theoretical field in each of 
the X, y and zdirections attributed to each of the nine radlatorcoils at the approximate sensor location defined by vectorT 
[0055] Fig. 4F shows a single loop radiator coil centered at Q and having a unit orientation vector 3/. The coil is 
centered a distance 3^ from the origin of the three-dimensional frame of reference. The vector Tconnects the origin 
with point M, the approximate sensor location from the triangulation as discussed above. The theoretical field at M due 
to radiator coil i may be found as follows: 
[0056] We may define the vector cor such that: oor^l- S/, 

[0057] The vector cor is of magnitude corresponding to the distance between the coil center, point Q, and point M. 
[0058] We may also define the scalar quantity z as the dot product of 5^. a vector describing the radiator coi) axis, 
and the vector cor: z-^fCor. 

[0059] The quantity z, as shown in Fig. 4F, is equal to the projection of cor on 3^. 

[0060] We may define the scalar quantity a/>sr as the absolute value of the vector cor : adsr = 

[0061] The scalar absr is equal to the distance between the coil center and point M. 

[0062] We may find and Sq, vector components of the magnetic flux density at the point M resolved along axes 
parallel and perpendicular, respectively to the line connecting point M and the coil as outlined in PCT patent application 
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publication WO 96/05768. ^ 

[0063] We may also define the quantities xvec and xnor as follows: 



xvec = cor 



xnor= ||xvec||. 

10 

[0064] It follows then from these relationships, as illustrated in Fig. 4F that 

. ^ xnor 
sinG = -r— 
absr 

15 

[0065] We may determine the magnetic field at location in the frame of reference of the radiator coil {xvec and 
20 by solving the following rotation matrix: 
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30 





cosff ^ 
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-sin^j 







G = 



[0066] The field at M in the frame of reference of the x, y, z coordinate systenn of Fig. 4F due to a radiator coll 
having a single turn is now given by the following equation: 



^0 = 



xvec 
xnor 



35 [0067] The calculated magnetic field ?,at M due to coil /having more than one tum is given by the following equation: 

Pf = ?o-(effective number of turns of the coil). 

40 [0068] The effective number of turns of a coil may not be equal to the actual number of turns due to inhomogeneities 
in the coil, caused, for example, by turns of different radii or by nonparallel turns. The effective number of turns of the 
coil may be determined by calibration of the coil, for example, by the method disclosed in PCT patent application 
publication WO 97/42517, the disclosure of which is incorporated herein in its entirety by reference. 
[00691 The calculation above provides the magnitude of the magnetic field at M due to coil / in each of the x, y and 

45 z directions. This calculation is repeated for each of the coils to provide the data for the matrix 



50 



as defined abovo. ^ 
[0070] We may now define a quantity /)(x), the calculated field of a sensor at M corrected for sensor orientation n 

as follows: 



55 



/7(if) =//(/)• /a. 
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[00711 Making the approximation that the sensor is actually located at the location value given by vectorT we may 
then substitute;, the actual measured value of the fields at the sensor for /5(x) In the above equation, affording 



10 



[0072] Rearranging this equation affords the following equation which provides a first approximate calculation of the 
sensor orientation vector n as follows: 



[0073] Step (c): Calculate the magnetic field at the estimated sensor position and orientation using magnetic field 
calculator 74. 

15 [0074] We recall from the Equation above that 



20 

[0075] Having previously calculated 




at approximate sensor location M denoted by vector^ and having calculated an approximate sensor orientation n, we 
may now calculate fi{x), the calculated field at position and orientation 

30 

using the Equation above. The vector ^(x) is the orientation-corrected magnetic field due to each of the nine radiator 
35 coils at a sensor at approximate position and orientation 

40 and, for the above-described system, Is of the fomn of a [9, 1 ] matrix. 

[0076] Step (d): Calculate the steepest descent (the Jacobian) from the calculated magnetic field at the estimated 
sensor position and orientation to the measured magnetic field at the sensor using the steepest descent calculator 76. 
[0077] We may calculate the Jacobian at 

45 

J =}/,«) 

as follows: 

so 

' dScj &ij ' 

55 

[0078] The Jacobian, J^, is the change in the calculated field fi{x) at calculated location and orientation 
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5 for each of the nine radiator coils (/ = 1 to 9), with respect to each of the six position and orientation variables (/ = 1 to 
6). The Jacobian is a 9 by 6 matrix having 9 rows and 6 columns. Each element in the Jacobian matrix is calculated 
by calculating the field due to each coil i at the position x. We then increment each of the six position variables by a A 
and then recalculate the field. The change in the field due to coil / with respect to each of the six position variables 
represents the six entries in the Jacobian matrix for coil /' The process is repeated for each of the nine coils. 

io [0079] In practice, it is quite computationally intensive to do all these calculations. Alternatively and preferably, values 
for each of the entries in the Jacobian may be calculated once and stored in a lookupjable. Individual entries may then 
be obtained by Interpolation between lookup table values wherein the increments in x are predetermined in the lookup 
table. 

[0080] We may define the matrix L, a 6 by 9 matrix, as follows: 

15 
20 

[0081] Matrix L Is a mean least squares inversion of the Jacobian. 

[0082] We may compute 5. the difference between the actual field at the sensor and the calculated field at the 
calculated sensor position and orientation as follows: 



[0083] We recall Equation that: 

30 



[0084] At the actual sensor location, the actual measured field would be equal to the calculated field, which gives 
rise to the following equation: 

35 

A(5)s7(Jt). 



40 [0085] At an approximate sensor location, the field at the approximate location, A?(x), can be related to the measured 
field at the actual sensor location 7as follows: 

45 

Recall that, 



S = 7- /)(Xn.l). 

so 

[0086] Since, 
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[0087] Thus, we wish to calculate a change (Ax) In the six-dimensional position and orientation variable x, which will 
cause the measured field to approach, and, ultimately, to equal the computed field at the calculated position and ori- 
entation of the sensor. From the parameters and equations defined above, that value of Ax which most steeply changes 
the calculated field at the calculated position and orientation in the direction of the measured field is given as follows: 



20 



= t.l. 



25 



30 



[0088] The vector Ax represents the value that is added to each of the six position and orientation coordinates of 
thG estimated sensor location and orientation to arrive at a new estimate of the sensor position and orientation for 
which the calculated field is closer to the measured field. 

[0089] Step (e): Calculate new estimate for sensor position and orientation using the new position and orientation 
estimator 78. _^ 

[0090] Having computed a value of Ax. we may add this value of Ax to the previous estimate of the sensor position 
and orientation to arrive at a new estimate of sensor position and orientation, as follows: 
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45 
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[0091] Additionally, pre-stored calibration information {a calibration factor) according to a plurality of points within the 
operating volume is introduced at the magnetic field calculator 74 and the steepest descent/Jacoblan calculator 76 in 
order to arrive at the new value/estimate of the position and orientation of the sensor at the new estimate calculator 
78. Accordingly, the calibration data is used with the process recited above since it is related to the calculation of the 
magnetic fields at the sensor coil 26 and the Jacobian. This calibration method Is described in greater detail below. 
[0092] Step (f): Determine whether the new estimate of position and orientation is within the desired measurement 
accuracy, e.g. < 0.1 cm (the accuracy of the system). However, the Incremental steps of the algorithm are stopped as 
soon as the change from a previous step is less than 0.001 cm as described above which is necessary In order to get 
better thani mm accuracy for the system. 

[0093] One or more criteria may be specified to establlshthe required accuracy of the newly estimated sensor position 
and orientation values. One criterion examines the absolute value of Ax, the position and orientation correction. If |ax| 
is less than a particular threshold value, it may be assumed that the position and orientation has been calculated to 
the desired accuracy. For example, a value of lAxI < 10 * cm (which results In an accuracy of more than 1 mm) is 
believed to meet the required accuracy criteria for sensors used in most biomedical applications. 
[0094] The above-described method of determining the sensor position and orientation involves calculation of the 
field ti(x) at the estimated sensor position and location 



55 We may define the quantity as follows: 
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5 [0095] The value of Af is another criterion that nr»ay be used to determine whether the sensor position and orientation 
have been found to the desired accuracy. For example, a value of A/< 1 Qr^ (which results in an accuracy of more than 
1 mm) has been found to be sufficiently accurate for most biomedical applications. 

[0096] Preferably both of these criteria are used to determine that position and orientation values have been deter- 
mined with the required accuracy. 
10 [0097] Step (g); Iterate field calculations (steps (c) - (e)) at newly estimated sensor position and orientation to refine 
position and orientation estimate. 

[0098] The procedure described hereinabove in steps (c) through (e) is iterated if the estimated position and orien- 
tation values do not meet one or both of the required accuracy criteria. Specifically, the newly estimated sensor position 
and orientation values from step (e) are used in step (c) to recalculate a magnetic field at the new estimated sensor 

15 position and orientation. The thus-calculated field value is used in step (d) to refine the steepest descent calculation. 
The refined steepest descent is used to determine a new estimate for the sensor position and orientation. One fail- 
safe mechanism utilized by the present invention is to limit the iteration number to a maximum number, for instance, 
to ten (10) iterations, so that if the algorithm does not converge for some reason, for example, due to the sensor coll 
26 being out of range, or a hardware problem, then the system 20 would not go into an infinite loop. The maximum 

20 iteration number or iteration number limit is also stored in the signal processor 25. 

[0099] A modification to the algorithm described above is employed for the alternative radiator arrangements illus- 
trated in Figs. 7-9. This modified algorithm is based on a "Global Convergent" method as outlined in Numerical Recipes 
(ISBN 052143108 pp.383) which is incorporated by reference herein. By utilizing a global convergent technique (as 
shown in Fig. 1 0), a more efficient convergence of the arbitrary starting point to the actual sensor position and orientation 

25 is achieved. Accordingly, the technique according to the present invention provides for a new correction to the current 
position AX (as a replacement for the Jacobian step performed by the steepest descent calculator 76 of Fig. 3). This 
novel global convergence method comprises the following steps: 
[0100] First, determine the direction of AX by the formula: 
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AX/lAXl. 

[0101] Second, find the minimum value of the change in the Field AF(AFmin.) along this direction. This position is 
determined by: 

AX'= C* AX (where 0<C<1). 
[0102] Third, update the sensor position according to: 

X-X+AX'. 



[0103] It is important to note that AX correction may not minimize the function AFif the estimated sensor position is 
45 too far from the actual position value. However, the direction of AX is the desired focus at this step. Thus, AF min. is 

determined by incrementing along the direction of AX. Accordingly, this value will be anywhere between 0 and AX. 

[0104] If the global convergent algorithm does not converge (within a predefined number of iterations) from a certain 

starting position, a different starting point may be selected. For instance, a point adjacent to the initial starting point 

may be utilized in the global convergent algorithm above until there is convergence. 
so [0105] One helpful technique is to divide the operating volume or working space into subvolumes of 5 cm X 5 cm X 

5 cm or (5 cm)3 so that there are a total of sixty-four trials to ensure convergence in any case. Accordingly, this procedure 

may be perfonned only once. Thus, after finding the first point, the result from the convergent technique is then used 

as an approximation for the algorithm. 

[0106] To summarize then, the method of the invention consists of the following steps: 



Step (a): Estimate an initial sensor position and orientation; 

Optional Step (b): Refine the estimated sensor position and orientation based on the dipole approximation; 
Step (c): Calculate the magnetic field at the estimated sensor position and orientation; 
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Step (d): Calculate the steepest descent from the calculated field at the estimated sensor position and orientation 
to the measured field at the sensor; 

Step (e): Calculate a new estinnate for sensor position and orientation which includes utilizing predetermined and 
stored calibration information stored in signal processor 25 in conjunction with steps (c) and (d): 
5 Step (f): Determine whether the newly estimated position and orientation are within the desired accuracy of the 

measurement; and 

Step (g): Iterate the calculations (steps (c) - (e)), up to the pre-stored maximum iteration number, i.e. the iteration 
number limit, at the newly estimated sensor position and orientation to refine the position and orientation estimate 
to the required accuracy (also pre-determined and stored In signal processor 25). 

10 

[0107] Alternatively, Step (d) above is replaced by the global convergent technique described above (Fig. 10) (for 
the radiator arrangements shown in Figs. 7-9). 

[0108] In practice, the method of the invention is applied to the sequential calculation of multiple number of sensors 
positions and orientations at a plurality of points in space. For the calculation of successive points that are closely 
15 spaced in time, it may be assumed that the sensor has not moved significantly since the previously determined values. 
Accordingly, a good value for the initial estimate of position and orientation for the n»^ position and orientation will be 
the values detennined at the n-1** position and orientation. 

Calibration System 

20 

[0109] A calibration system 90 according to the present invention is operably connected to the position and orientation 
sensing system 20 (Figs. 1 and 2). The calibration system 90 is directed at providing calibration data that is pre-stored 
in the signal processor 25 which is used in perfomriing an accurate detenninaticn of the sensor coil 26 (Fig. 2) position 
and orientation when introduced into the operating volume. As shown in Fig. 5, the calibration system 90 includes 
25 primary components of the position and orientation system 20 including the signal processor 25, the radiator drive 64 , 
the location pad 61 and radiator or generator coils 32, 34, 36, 38, 40, 42, 44, 46 and 48 wound around spools forming 
radiators or generators 56, 58 and 60 respectively along with the respective wires 62. 

[0110] The calibration system 90 further includes a test position sensor 100 having three sensor coils 102, 104 and 
106 which are oriented in the X, Y and Z coordinate planes (coordinate axes) respectively as depicted. The pitch 

30 distances between the coils in the sensor 1 00 is 1 -0.02 cm. The test position sensor 1 00 is operably connected to the 
signal processor 25 by wire 28 for processing sensor signals provided by the test position sensor 100. Additionally, 
the test position sensor 100 is operably connected to a positioning device such as a robot arm 110 by wire 112. The 
robot arm 1 1 0 is operably connected to the signal processor 25 by wire 1 1 4. The processor 25 has predetermined test 
positions according to the three coordinate system, e.g. X, Y, Z coordinate axes. Preferably, approximately one hundred 

35 and fifty (150) test positions are predetermined and stored in the processor 25. These test positions closely align with 
the operating volume produced by the generators 56, 58 and 60 when energized. Since the processor 25 is programmed 
with each of these test positions, the robot arm 1 1 0 can be accurately guided and positioned at each test position. This 
method will become much clearer when described In greater detail below. 

40 Calibration Method Including Algorithm 

[0111] In general, in the calibration method according to the present invention, the theoretical fields of the location 
pad 61 (Fig. 5) are adapted to the measured field of a specific position and orientation system 20. Accordingly, each 
system 20 is customized with its own calibration data which is used during the location calculations when detemnining 

45 the position and orientation of a sensor coil 26 (Figs. 1 and 2) as mentioned above and depicted in the schematic flow 
chart of Fig. 3. Commonly assigned pending US patent applcation no. 09/180,244, entitled Radiator Calibration, also 
addresses techniques for calibrating magnetic field generators or radiator coils and is incorporated by reference herein. 
[01 12] Fig. 6 shows a schematic flow chart for the calibration method according to the present invention. Accordingly, 
with this calibration method, the predetennined test positions for the operating volume are stored in the processor 25. 

so Although one hundred and fifty (1 50) test positions are preferably utilized, any number of test positions may be utilized 
depending on the size of the operating volume desired and th e degree of accuracy detennined necessary. As mentioned 
above, these test positions (X,, Yj, Z,) substantially conform to the operating volume, for instance, 20 cm X 20 cm X 20 
cm or (20 cm)3. As defined herein, the terms "mapping volume", "sampling volume" and "mapping area" are analogous 
terms for "operating volume" and are used interchangeably throughout this disclosure. 

55 [01 1 3] First the radiator coils of radiators or generators 56, 58 and 60 of the position system 20 are activated through 
simultaneous energizing using a frequency multiplexing technique in order to create nine distinct magnetic fields (quasi- 
stationary magnetic fields) and establish the operating volume. Then the robot ami 110 is guided and accurately po- 
sitioned at each respective test position (X|, Yj, Z,) and the X.Y and Z components of the magnetic field are measured 
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at the test position sensor 1 00. After each nneasurennent, the processor 25 checks the sampling of these test positions 
in order to deternnine If a requisite sanripling volunfie has been achieved. The sampling volume corresponds to the 
operating volume of the field radiators 56, 58 and 60. Once the desired sampling volume has been completed, the 
processor 25 correlates the known theoretical magnetic fields at each test position (X;. Y,, Zj) to the actual measured 

5 field at each test position (Xj, Y|, Z,). This correlation is a mathematical transformation that maps the theoretical magnetic 
fields at the acquired points (Xj, Y^, Zj) to the measured fields at these test points (Xj, Y|, Zj). Thus, this correlation is a 
mapping calculation and the results are stored in the processor 25 for each position (Xj, Y|, Zj) and are recalled during 
a position and orientation sensing procedure such as that previously described, for example, with the system 20 de- 
picted in Fig. 1 . The calibration data from these stored calibration files is used to correct the theoretical magnetic fields. 

10 [0114] One example of the calibration method employing the calibration system 90 (Fig. 5) Is outlined below. As 
shown, using the calibration system 90, the X, Y, Z components of the magnetic field is measured using the three-axis 
test position sensor 100 comprising three orthogonal sensor coils 102. 104 and 106 whteh provide sensor signal infor- 
mation to the processor 25 of the position system 20. In order to calculate the mapping between the location pad fields 
and the theoretical fields, one needs to know the exact coordinates of the measurement with respect to each of the 

15 colls 32, 34, 36, 38, 40, 42. 44, 46 and 48 respectively of the location pad 61 . To this end, the robot arm 11 0 is aligned 
with the location pad coordinate system, e.g. the sampling volume, using the predefined test positions (Xj, Y|, Zj). One 
acceptable sequence is as follows: 

a) Bring the robot arm 110 to a specified lest position Xo,Yo,Zo which is a lest position for measuring relative to 
20 the Z coil 106 of the test position sensor 100. 

b) Take a measurement of the magnetic field of the Z component using the Z coil 1 06 of the test position sensor 1 00. 

c) Step the robot arm 110 such that the test position sensor 100 is moved 1 cm forward (this places Y coil 104 at 
the same point previously occupied by the Z coil 106)= and measure the magnetk; field of the Y component using 
Y coil 104 of the tost position sensor 1 00 . 

25 d) Step the robot arm 110 such that the test position sensor 100 is again moved 1 cm forward (placing the X coil 

102 at the point previously occupied by the Z coil 106 during the first measurement and by the Y coil 104 during 
the second measurement) and measure the magnetic field of the X component using X coil 1 02 of the test position 
sensor 1 00 . 

30 [01 1 5] As mentioned above, a typteal calibration process Is perf omied in a sampling volume of 20 cm X 20 cm X 20 

cm around the center and above the location pad 61 which corresponds to the operating volume when the system 20 
(Figs. 1 and 2) is used for medical purposes. Additionally, the steps between two successive points/positions are 2-3 
cm in each direction though the steps need not be constant through all of the sampling volume. Typically, there are 
one hundred and fifty (150) points sampled in the entire sampling volume. Thus, at the end of the calibration method, 
35 we have: 

{&j\J=i ...9,/=1 ...sISO} 

40 [0116] Where the i index Is the number of points index and j Is the frequency index for each generator coil at distinct 
frequencies. Thus, the index / refers to the measured fields for all of the test positions, e.g. 150. 
[01 1 7] The mathematical transfonnation is outlined below. We assume that at any given region of space there exists 
a rotation transformation between the measured fields and the theoretical fields. Thus, we can rely on the equation: 

OS^=B„ (6) 

whereby O Is a 3x3 rotation matrix that Is given by the equation: 

50 -1 ,^ 

0=B^B^' (7) 

[0118] It is important to note that both B^, and 8,^ are [3x150] matrices and the mathematical transformation maps 
B„ and as close as possible in the least mean square sense. Also, note that in equation (7), we assumed that the 
5^ same transfonnation is applied to the entire space volume. In fact, wo may have a separate rotation matrix to each 
subvolume of our mapping space. For instance, one can divide the mapping volume into sub-cubes having a subvolume 
of 5 cm X 5 cm X 5 cm, e.g. each sub-cube being (5 cm)^ and calculate the rotation matrix which is relevant to each 



16 



<EP_ . 1174CS2A1 I > 



EP1 174 082 A1 



of the sub-cubes. This rotation matrix is then stored in the signal processor 25 with the calibration inf onnation regarding 
its position in space. This procedure is conducted for each radiator coil 32. 34, 36, 38, 40, 42, 44, 46 and 48. Typically, 
one can derive approximately twenty (20) - thirty (30) 3x3 matrices for each coil 32. 34, 36. 38. 40, 42, 44, 46 and 48. 
[0119] Accordingly, if one were to begin at a starting point x. then the theoretical field at the point ^thM can be 
5 calculated by the algorithm of the present invention. Then, the "new" theoretical field Is given by the expression: 

0(x)B(x) 

10 [0120] Where o(x) is the relevant transf onnation at the point x. And for the calculated theoretical Jacobean to be J 
(x), then the "new" calibrated Jacobean is given by the equation: 

0(x)J(x) 

15 

[0121] Accordingly, both the calibrated B (magnetic field) and J (Jacobean) are used in the algorithm of the present 
invention In the same manner that noncalibrated versions are used. However, with the added calibration information 
(the calibrated B), the system 20 has greater position accuracy which is particularly useful in medical procedures. 

20 Calibration Method with Static Metal Compensation 

[01 22] The present invention also includes a novel calibration method for the radiators 56, 58 and 60 of the position 

and orientation system 20 (Fig. 1) capable of compensating for the effects of disturbances caused by nonmoving or 
static metallic objects placed within the mapping or operating volume. The calibration method is used in conjunction 
25 with the calibration system 90 shown in Fig. 5 including the robot arm 1 1 0 to ensure accuracy. Moreover, this calibration 
method is useful for various arrangements of the radiators 56, 58 and 60 to include the radiator arrangement embod- 
iments shown in Figs. 5. 7. 8 and 9. 

[0123] Accordingly, a metallic object (not shown), such as the C-ann of a fluoroscopic device, is placed within the 
intended mapping volume generated by the radiators 56, 58 and 60. The purpose of this step is to establish calibration 
30 data for storage in the signal processor 25 that takes into account the disturbance effects provided by the metallic 
object on the magnitude and direction of the magnetic fields generated by the radiator coils 32, 34, 36, 38, 40, 42, 44, 
46 and 48 of the radiators 56, 58 and 60 respectively. 

[0124] As mentioned above, a preferred mapping volume is the magnetic field Inside an area approximately 20 cm 
X 20 cm X 20 cm or (20 cm)3. The calibration method according to the present invention takes into account the magnetic 
35 field produced by any metal object located within the mapping volume. Once the magnetic field is mapped according 
to the method of the present invention described in greater detail below, for instance, using the single-axis sensor 
algorithm associated with the system 20 (Fig. 1), one can use the system 20, even in the presence of one or more 
metallic objects, as if it was a completely undisturbed magnetic field situation, i.e. a situation without the presence of 
metallic object interference. 

40 [0125] One embodiment of the method according to the present invention is best illustrated in the schemata flow 
chart of Fig. 12. First, an intended mapping volume is defined and one or more static metallic objects are placed within 
the intended mapping volume. Again, these metallic objects would be those objects located within the sterile field of 
the patient and within the mapping volume. One example of a typical nonmoving (nonmoving meaning only relative to 
the location pad) metallic object Is the C-arm of a fluoroscopic device. Accordingly, the C-ami is placed within the 

45 mapping volume, 

[0126] Turning now to Figs. 5 and 11, the robot arm 110 moves the position sensor 100 to a starting point to begin 
a mapping and calibration procedure by creating a mapping calibration cube 200a. For example, the starting point is 
a position or point beginning at the vertex of a cube having a volume of (3 cm)3. For example, an appropriate first point 
or starting position is the point 210 of the cube 200a shown in Fig, 11. 

so [0127] The sensor 1 00 is aligned at the first point or coordinate position 21 0 represented according to three dimen- 
sional coordinate (Xj, Yj, Z,) within the mapping calibration cube 200a (within the mapping volume) and the magnetic 
field of the radiator coils 32, 34, 36, 38, 40, 42, 44, 46 ,48 is read and measured at the first point to establish the first 
coordinate position 21 0 with the sensor 1 00 through the signal processor 25. The sensor 1 00 is then stepped or moved 
to a next or second point 220 (Xj + dx, Yj + dy, Z, + dz) defined by the first position and an added distance component 

55 (dx, dy, dz) by the robot arm 110. The magnetic field at the second point 220 is then read and measured through the 
signal processor 25 to establish a next or second coordinate position 

[0128] The signal processor is preprogrammed with the calibration positions of the calibration cube 200a which are 
the vertices (210. 220, 230, 240, 250, etc.) of a (3 cm)3 volume cube. The robot arm 110 steps the sensor 100 in 
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incremental predetermined distances ranging between 2 - 3 cm (preferably the stepped distance is 3 cm). The exact 
step distance Is predetermined and remains constant throughout this calibration mapping procedure with the only 
exception being where accounting for metallic disturbance effects at a particular position. This modification to step 
distance is specifically addressed below. 
5 [0129] For example, for the procedure schennatically Illustrated in Fig. 11, the step distance is 3 cm (along one of 
the coordinate axes X, Y or Z) for each vertex point or position 210. 220, 230, 240 and 250. Additionally, the robot arm 
110 steps the sensor 100 according to the direction of the an^ows along the edges of the cube 200a (along each 
coordinate axis). 

[0130] Once the magnetic field is measured and the position determined at the first point 21 0, e.g. first coordinate 

10 position (Xj, Yj, Z) and at the next or second point 220, e.g. next or second coordinate position (Xj = Xj + dx, Yj = Yj + 
dy. Zj = Zj + dz), reflecting the added distance component dx, dy, dz where dx = 3 cm ( also referred to as the step or 
stepped distance), the magnetic field at an Intemiedlate point 220a between the first position 210 and the second 
position 220 is interpolated and the position coordinate of the intenmediate point 220a is calculated by the signal proc- 
essor 25. It Is Important to note that the intemriediate point 220a will lie along the coordinate axis of the stepped distance, 

15 for instance, within a 3 cm distance along the X coordinate axis between vertlce points 21 0 and 220. 

[0131] After interpolating the magnetic field of the intennediate point 220a and calculating the position of the Inter- 
mediate point (calculated Intennediate position using the position and orientation algorithm), the signal processor 25 
takes the difference between the calculated intermediate position and the actual intennediate position. The Intermediate 
position difference (e) is then compared to an error limit also preslored in the signal processor 25. Although the error 

20 limit may be any value, an error limit < 1 mm has been found to be reasonable and an acceptable error limit. 

[0132] The next or second point (X^ Yj Zj) is then set as (X| = Xj + dx, Y| = Yj + dy, Zj = Z| + dz) by the signal processor 
25 if the position difference (e) is within the error limit (< 1 mm) and the robot ann 1 1 0 steps the sensor 1 00 to another 
point 230, e.g. a third or another next point (third coordinate position along another coordinate axis, e.g. Y axis (third 
vertex of cube 200a along step distance dy = 3 cm). 

25 [0133] If the intermediate position difference (e) is not within the error limit, e.g. e is not < 1 mm, the signal processor 
25 decreases the value of the added distance component, e.g. sets dx, dy, dz as dx-dx/2, dy^dy/2. d2=dz/2 . For 
example, the added distance component dx is decreased to 1 .5 cm (3 cm -s- 2 cm and whereby dy=dz=0) and the robot 
arm 110 repeats the step to a new second point 220b along the same coordinate axis, e.g. X axis. Accordingly the 
sensor 100 is stepped an added distance component of dx=1 .5 cm to the new second point/vertice 220b whereby the 

30 magnetic field is read at point 220b and its position is determined (new second coordinate position). The magnetic field 
Is then interpolated for a new intennediate point 220c. e.g. a point/position between the new second position 220b and 
the first position 21 0 and the position of the intermediate point 220c is calculated (new intennediate position) using the 
position and orientation algorithm. And, just as before, the new intennediate calculated position is compared to the 
actual position of the intennediate point 220c to determine if this difference (e) is within the error limit (< 1 mm). If the 

35 position difference (e) is within the error limit, the robot amn steps the sensor 100 to yet another point vertice 230a 
(position vertice) of the cube 200a along another coordinate axis, e.g. Y axis by the added distance component dy=3 
cm and repeats the steps outlined above for each vertice of cube 200a. 

[0134] As mentioned above, the added distance component of the intermediate point Is set by decreasing the value 
of the added distance component if the position is not within the error limit. The method steps are repeated after making 

40 the decreased adjustment to the added distance component. 

[0135] This calibration mapping process accounting for static metal compensation is continued according to a series 
or plurality of created mapping calibration cubes beginning with the mapping of a second adjacent cube 200b until the 
complete mapping volume of 20 cm X 20 cm X 20 cm or (20 cm)^ is completely mapped and calibrated accounting for 
existing metallic objects within the mapping volume. It is important to note that each of the mapping calibration cubes 

45 200a, 200b, etc. may very well be cubes having sides that are not of equal lengths due to the effects of a metallic object 
encountered during the mapping of a particular cube. 

[0136] A second embodiment of the calibration method according to the present invention utilizes extrapolation of 
the magnetic field at the next point. As shown in Fig. 13, in particular, first, the metallic object is placed within the 
intended mapping volume. Again, the robot arm 110 positions the sensor 100 at the first point 210 (starting or first 

50 position Xj, Yj, Zj) and the magnetic field at this first point Is read and measured by the signal processor 25 to determine 
the first coordinate position. Next, the signal processor 25, extrapolates the magnetic field at the next or second point 
220, e.g. next or second coordinate position (next vertex of mapping cube 200a which is the extrapolated point) defined 
as (Xj = Xj + dx, Yj = Yj + dy, Z, = Zj + dz) which includes the added distance component dx, dy, dz as appropriate. In 
this case, the added distance component (dx) is a 3 cm distance along the X coordinate axis. 

55 [0137] Once the magnetic field for the second point (the next point) is extrapolated, the location coordinate of this 
point 220 (calculated second position) is calculated using the position and orientation algorithm and compared to the 
actual position coordinate of the second point 220 in order to detennine the position difference (f). If the position 
difference (e) is within the predefined error limit stored in the signal processor 25, the robotic arm 1 1 0 moves the sensor 
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100 to a new point 230 (next vertice) along another coordinate axis, e.g. Y axis and the steps above are continued 
along the Y coordinate axis, etc. If the position difference (?) is not within the enror limit of 1 mm, the magnetic field is 
extrapolated for an intemnedlate point 220b, e.g. intermediate position coordinate (Xj + dx/2, Yj + dy/2. Zj + dz/2) 
between the second point 220, e.g. second coordinate position and the first point 210, e.g. first coordinate position 

5 (still along the same coordinate axis). Although, in this example, the added distance component dx is decreased by a 
factor of two (2), any sufficient factor to decrease the added distance component will suffice. A magnetic field meas- 
urement is then taken at the intermediate point 220b with the sensor 1 00 and signal processor 25 in order to determine 
the intemnediate position coordinate using the position and orientation algorithm. From the intermediate position 220b 
(which is actually a new second or next point), the rest of the steps are followed in sequence which includes detennining 

10 the position difference (e) of the intermediate point 220b (new second point) and determining whether 8 < 1 mm. 

[0138] The mapping calibration procedure is continued in accordance with the method steps shown in Fig. 13 thereby 
creating new mapping cubes 200b, etc. until the entire mapping volume is completed (approximately 20 cm X 20 cm 
X 20 cm or (20 cm)^ volume). 

[0139] It is clearly contemplated by the present invention that the steps of the methods and algorithms outlined 
15 throughout this disclosure may be sequenced differently than the sequences described above which served for example 
purposes only. It is clearly contemplated that the sequencing of these steps may be alternated and, in some instances, 
optionally deleted and still satisfy the novel requirements of the present invention. 

[0140] It will be appreciated that the preferred embodiments described above are cited by way of example and the 
full scope of the invention is limited only by the claims, which follow. 

20 

Claims 

1 . A system for determining the position of a medical device having a sensor, said system comprising: 

25 

a plurality of field radiators, each field radiator having a plurality of radiator elements, each radiator element 
generating a magnetic field distinct from one another through simultaneous energizing of said radiator ele- 
ments; 

a signal processor operatively connected to said field radiators and said sensor of said medical device, said 
30 signal processor receiving a sensing signal from said sensor Indicative of the magnetic field sensed at said 

sensor said sensing signal defining a measured magnetic field at said sensor, said signal processor also 
having a desired range of accuracy for said system stored therein, said signal processor including: 

(a) an initial position estimator for establishing an initial position estimate for said sensor; 
35 (b) a magnetic field calculator for calculating the magnetic field at said initial position estimate; 

(c) a steepest descent calculator for calculating a steepest descent of said calculated magnetic field to 
said measured magnetic field; and 

(d) a new position estimate calculator for calculating a new position estimate of said sensor based on said 
steepest descent; 

40 

wherein said signal processor determines said position of said sensor when said new position estimate of said 
sensor is within said desired range of accuracy. 

2. The system according to Claim 1 , wherein said field radiators are aranged in a fixed arrangement. 

45 

3. The system according to Claim 1 or Claim 2, wherein said signal processor detemnines a position and orientation 
of said sensor. 

4. The system according to Claim 3, wherein said position is in three different directions (X, Y, 2) and at least two 
50 orientations (pitch and yaw). 

5. The system according to Claim A, wherein said radiator elements of said field radiators arc mutually orthogonal. 

6. The system according to Claim 5, wherein said radiator elements of said field radiators are not mutually orthogonal. 

55 

7. The system according to Claim 5 or Claim 6 , wherein said radiator elements of said field radiators are not co-located. 

8. The system according to Claim 5 or Claim 6, wherein said radiator elements of said field radiators are co-located. 
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9. The system according to any one of Claims 5 to 8, wherein said system further comprises a display operatively 
connected to said signal processor for displaying said position and said orientation of said sensor. 

10. The system according to Claim 9, wherein said display displays said position and said orientation of said sensor 
5 with respect to an anatomical feature of a patient. 

11. The system according to Claim 10, wherein said system further comprises a reference device for establishing a 
frame of reference. 

10 12. A system for determining the position of a medical device having a sensor, said system comprising: 

a plurality of field radiators, each field radiator having a plurality of radiator elements, each radiator element 
generating a magnetic field distinct from one another through simultaneous energizing of said radiator ele- 
ments; 

15 a signal processor operatively connected to said field radiators and said sensor of said medical device, said 

signal processor receiving a sensing signal from said sensor indicative of the magnetic field sensed at said 
sensor, said sensing signal defining a measured magnetic field at said sensor, said signal processor also 
having a desired range of accuracy for said system stored therein, said signal processor Including: 

20 (a) an initial position estimator for establishing an initial position estimate for said sensor; 

(b) a magnetic field calculator for calculating the magnetic field at said initial position estimate; 

(c) a global coverger for determining the minimum field at said sensor based on a direction of the initial 
position estimate; and 

(d) a new position estimate calculator for calculating a new position estimate of 

25 

said sensor based on said steepest descent; 

wherein said signal processor determines said position of said sensor when said new position estimate of said 
sensor is within said desired range of accuracy. 

30 

13. The system according to any one of Claims 1 to 12, wherein said signal processor includes pre-stored calibration 
information. 

14. The system according to Claim 13, wherein said desired range of accuracy is < .0001 cm. 

35 

15. A method of determining the position and orientation of a sensor relative to a plurality of field radiators of known 
location, each of said field radiators comprising a plurality of co-located radiator elements, each radiator element 
generating a magnetic field distinct from one another through simultaneous energizing of said radiator elements, 
said sensor producing sensing signals indicative of a measured magnetic field at said sensor, said method com- 

40 prising the steps of: 

(a) establishing a desired range of accuracy; 

(b) determining an Initial estimate of sensor position and orientation; 

(c) calculating a magnetic field at the estimated sensor position and orientation; 

45 (d) calculating the steepest descent from the calculated magnetic field at the estimated sensor position and 

orientation to the measured magnetic field at the sensor; 

(e) calculating a new estimate for said sensor position and orientation from said steepest descent, 

(f) Iterating steps (c) - (e) based on said newly calculated sensor position and orientation estimate of step (e) 
to refine the sensor position and orientation estimate. 

so 

16. A method of determining the position and orientation of a sensor relative to a plurality of field radiators of known 
location, each of said field radiators comprising a plurality of co-locatod radiator elements, each radiator clement 
generating a magnetic field distinct from one another through simultaneous energizing of said radiator elements, 
said sensor producing sensing signals indicative of a measured magnetic field at said sensor, said method com- 

55 prising the steps of: 

(a) establishing a desired range of accuracy; 

(b) detenmining an initial estimate of sensor position and orientation: 
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(c) calculating a magnetic field at the estimated sensor position and orientation; 

(d) determining a minimum magnetic field at said sensor based on a direction of the Initial position estimate 
using a global convergent technique; 

(e) calculating a new estimate for said sensor position and orientation based on said minimum magnetic field; 
5 (0 iterating steps (c) - (e) based on said newly calculated sensor position and orientation estimate of step (e) 

to refine the sensor position and orientation estimate. 

17. The method according to Claim 1 5 or Claim 1 6, wherein said desired range of accuracy is < .0001 cm. 

10 18. The method according to Claim 1 7, including establishing and storing calibration information for said field radiators. 

1 9. The method according to Claim 1 8, wherein said calibration information is used at steps (c) and (d) for calculating 
a new estimate for said sensor position and orientation. 

15 20. The method according to Claim 19, including refining said initial estimate of sensor position and orientation using 
a dipote approximation after step (b). 

21. The method according to Claim 20, including determining the position of said sensor in three different directions 
{X, Y, Z) and orientation of said sensor in at least two orientations (pilch and yaw). 

20 

22. The method according to Claim 21 , including displaying said position and orientation of said sensor. 

23. The method according to Claim 22, including displaying said position and orientation of said sensor with respect 
to an anatomical feature of a patient. 

25 
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